State Estimation for Legged Robots - Consistent Fusion of Leg Kinematics and IMU
نویسندگان
چکیده
This paper introduces a state estimation framework for legged robots that allows estimating the full pose of the robot without making any assumptions about the geometrical structure of its environment. This is achieved by means of an Observability Constrained Extended Kalman Filter that fuses kinematic encoder data with on-board IMU measurements. By including the absolute position of all footholds into the filter state, simple model equations can be formulated which accurately capture the uncertainties associated with the intermittent ground contacts. The resulting filter simultaneously estimates the position of all footholds and the pose of the main body. In the algorithmic formulation, special attention is paid to the consistency of the linearized filter: it maintains the same observability properties as the nonlinear system, which is a prerequisite for accurate state estimation. The presented approach is implemented in simulation and validated experimentally on an actual quadrupedal robot.
منابع مشابه
Consistent Fusion of Leg Kinematics and Inertial Measurements for State Estimation of Legged Robots
The control performance of legged robots and floating base systems in general strongly depends on the underlying state estimation. This becomes especially important as soon as it comes to dynamic maneuvers or challenging terrain, where purely leg kinematics based pose estimators often fail. In order to avoid the usage of an external tracking system, we propose a filtering method that integrates...
متن کاملLegged Robot State-Estimation Through Combined Forward Kinematic and Preintegrated Contact Factors
State-of-the-art robotic perception systems have achieved sufficiently good performance using Inertial Measurement Units (IMUs), cameras, and nonlinear optimization techniques, that they are now being deployed as technologies. However, many of these methods rely significantly on vision and often fail when visual tracking is lost due to lighting or scarcity of features. This paper presents a sta...
متن کاملImplementation of a Low- Cost Multi- IMU by Using Information Form of a Steady State Kalman Filter
In this paper, a homogenous multi-sensor fusion method is used to estimate the trueangular rate and acceleration with a combination of four low cost (< 10$) MEMS Inertial MeasurementUnits (IMU). An information form of steady state Kalman filter is designed to fuse the output of four lowaccuracy sensors to reduce the noise effect by the square root of the number of sensors. A hardware isimplemen...
متن کاملA New Approach to Self-Localization for Mobile Robots Using Sensor Data Fusion
This paper proposes a new approach for calibration of dead reckoning process. Using the well-known UMBmark (University of Michigan Benchmark) is not sufficient for a desirable calibration of dead reckoning. Besides, existing calibration methods usually require explicit measurement of actual motion of the robot. Some recent methods use the smart encoder trailer or long range finder sensors such ...
متن کاملKinematic Calibration and Sensor Fusion for Legged Robots
While the current progress in actuation schemes, sensor setups, and mechanical design allows the development of increasingly performing legged robots, motion planing and control of such systems still pose challenging problems. Our group contributes to the ongoing research by focusing on the calibration, state estimation, and perception of legged platforms. Especially in rough and unstructured t...
متن کامل